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I.   INTRODUCTION 

A.   BACKGROUND 

The  concept  of  a  hierarchical  automated  intelligent 
controller,  or  autopilot,  as  a  state-of-the-art  design 
methodology  is  clearly  evident  from  the  proceedings  of  [Ref. 
1] .    As  a  part  of  an  inter-disciplinary  research  program, 
the  Naval  Postgraduate  School  is  investigating  many  facets 
of  automated  control  technologies  for  underwater  vehicles. 
One  of  the  objectives  of  this  program  has  been  to  develop 
operating  "test-bed"  vehicles  and  the  facilities  for 
developing  and  evaluating  real-time  control  systems. 

In  support  of  this  objective,  recent  studies  have  led  to 
the  development  of  a  model-referenced  control  methodology. 
Using  the  equations  of  motion  for  a  vehicle  of  known 
hydrodynamic  characteristics,  computer  simulation  was  used 
to  develop  the  command  generation  logic,  the  design  of  a 
model  following  autopilot  and  evaluate  the  performance  of 
the  selected  AUV  computer  model  [Ref.  2]. 

Based  on  this  vehicle's  characteristics,  subsequent 
research  led  to  the  design  and  construction  of  the  first  of 
a  series  of  operational  AUV  models  which  will  be  used  to 
evaluate  evolving  automated  control  technologies  [Ref.  3], 
This  model  was  used  to  develop  a  technique  for  the 
identification  of  discrete  transfer  function  relationships. 


In-water  tank  tests  were  conducted  for  maneuvers  in  the 
vertical  plane  and  from  these,  data  was  acquired   and 
compared  with  the  computer  model  simulation.   A  system 
transfer  function  relating  dive  plane  commands  to  vehicle 
response  was  then  determined. 

B.   RESEARCH  OBJECTIVES 

The  focus  of  this  research  has  been  to  implement  a 
microcomputer  based  capability  to  support  AUV  data 
acquisition,  vehicle  response  and  transfer  function 
identification,  and  the  development  of  real  time  digital 
control  programming. 

Specific  objectives  included: 

1.  The  acquisition  and  integration  of  available 
hardware  and  software. 

2.  The  documentation  of  specific  implementations  and 
configurations  used  for  the  various  phases  of 
program  development  to  date. 

3 .  The  development  of  a  high-level  language  program 
for  real-time  control  of  the  AUV  test  vehicle 
dive  plane  maneuvering  based  on  the  methodology 
and  results  of  the  research  reported  [Refs.  2,3]. 
This  program  would  affirm  the  on-site  development 
procedure  and  identify  insufficiencies  or 
incompatibilities  which  would  need  to  be 
resolved  to  support  future  research. 

This  thesis  documents  the  accomplishment  of  these 

objectives.   The  integration  of  hardware  and  software  are 

discussed  and  evaluate  in  the  overall  perspective  of  the 

program  development  process.   A  program  was  developed  and 

verified.   This  control  program  was  written  in  Turbo  Pascal 

and  processes  three  analog  sensor  signals  and  issues  a 


digital  diveplane  command.   The  development  procedure  has 
been  verified,  however  certain  shortcomings  in  multi-channel 
signal  processing  and  software  compatability  are  discussed. 


II.   EQUIPMENT  DESCRIPTION,  APPLICATION  AND 
PROCEDURAL  DOCUMENTATION 


A.   THE  DESIGN  AND  CONTROL  PROGRAM  DEVELOPMENT  PROCESS: 
AN  OVERVIEW 

The  development  of  real-time  autonomous  control  programs 
is  a  dynamic  and  evolutionary  process.   It  is  the  link 
between  computer  simulations  of  the  systems  and  the 
implementation  of  controllers  to  achieve  desired  performance 
of  these  entities  in  the  real-world.   Autonomous  controllers 
are  exceedingly  complex.   In  the  early  stages  of  controller 
development,  software  implementations  operating  in 
micro-computers  which  interface  the  device  afford  an 
opportunity  for  verification  and  optimization  of  design 
methodology  and  parameters.   Once  designs  have  been 
evaluated,  the  design  logic  is  then  implemented  in  an 
onboard  controller.   In  this  final  implementation,  much  of 
the  control  program  coding  will  have  been  replaced  by 
functionally  equivalent  micro-electronic  devices  which 
permit  economies  in  size  and  power  as  well  as  flexibility  of 
application.    The  remaining  control  logic  is  micro-coded 
and  programmed  on  micro  electronic  storage  devices. 

A  principal  objective  of  this  research  was  the 
integration  of  available  software  and  hardware  to  support 
the  various  activities  in  control  program  development  for 
the  AUV.   These  activities  fall  into  three  broad  categories: 


Data  Acquisition,  Data  Analysis,  and  Design  and 
Implementation  of  real-time  control  programs. 

-  Data  Acquisition  involves  the  assimilation  of  vehicle 
parameters  and  responses  to  known  inputs  under 
controlled  conditions. 

-  Data  Analysis  involves  the  analysis  of  vehicle 
performance  data  for  the  purpose  of  extrapolating 
quantitative  relationships  between  input  commands  and 
vehicle  responses.   These  relationships  are  then 
reflected  as  gain  factors  in  transfer  functions  which 
describe  the  AUV  behavior  or  state. 

-  Design  and  Implementation  of  real-time  control  programs 
entails  the  representation  of  controller  logic  in 
programming  code.   This  software  operates  in  a 
micro-computer  suitably  interfaced  with  the  AUV  to 
permit  the  sampling  of  vehicle  sensor  data  and  to  issue 
appropriate  commands. 

This  chapter  summarizes  the  specifications  of  the 

hardware  and  the  software  utilized  to  support  these  phases 

in  the  research  reported  herein.   The  phases  and  application 

of  these  resources  are  depicted  in  Figure  2.1.    Concluding 

sections  of  this  chapter  document  specific  configurations 

and  commentary  which  supplement  manufacturer's  technical 

reference  materials  with  regard  to  this  research 

application.   Comments  regarding  the  performance  and 

suitability  of  these  resources  are  reported  in  Chapter  IV. 

B.   MICROCOMPUTER  DESCRIPTION 

An  IBM  PC/AT  (compatible)  microcomputer  was  acquired  for 
this  and  future  research.   This  computer  operates  at  6  or  10 
MHz  and  with  0  or  1  wait  states.   An  Intel  80286 
microprocessor  and  an  80287  math  co-processor  were 
installed.   The  Random  Access  Memory  (RAM)  is  expandable 
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Figure   2.1      Phases   of   Program  Development 


from  its  current  size  of  640  Kbytes.   Installed  floppy  disk 
drives  include  a  1.2M  byte  (high  density)  and  360K  byte 
floppy  disk  drives  are  installed.   The  floppy  disk 
controller  has  the  capability  of  controlling  an  additional 
3.5  inch  disk  drive  as  well.   A  40M  byte  hard  disk  is  also 
installed. 

C.   SIGNAL  PROCESSING:   ANALOG- DIGITAL  INTERFACE 

Interfacing  the  micro-computer  and  the  AUV  is  critical 
to  the  program  development  process.   At  this  interface 
analog  AUV  sensor  signals  are  digitized  for  the  computer 
control  program  through  an  A/D  conversion  process. 
Similarly,  digitized  command  signals  are  converted  to  analog 
equivalent  signals  by  D/A  conversion  processing  prior  to 
transmission  to  the  AUV  analog  servo-control  components. 
The  A/D  signal  processing  was  utilized  exclusively  during 
AUV  test  trials  for  data  acquisition.   Both  modes  of  signal 
processing  were  utilized  in  development  of  the  control 
program.   A  detailed  description  of  the  configurations 
during  these  phases  are  reported  later  in  this  chapter. 
This  section  concludes  with  a  description  of  the  devices 
used  to  achieve  the  analog-digital  signal  processing 
interface  and  a  summary  of  the  technical  specifications 
detailed  in  the  manufacturer's  literature  [Ref.  4]. 

Interfacing  the  AUV  and  the  computer  was  accomplished 
using  two  modern  device  boards.  The  model  DT  2801-A  is  a 
programmable, single  board,  analog  and  digital  I/O  signal 


processor.   This  board  is  one  of  a  series  designed  for  the 
IBM  Personal  Computers  and  was  installed  into  one  of  the 
backplane  slots  on  the  computer's  mother  board.   Once 
installed,  a  multi-pin  connector,  accessible  at  the  back  of 
the  computer,  facilitates  connecting  the  DT  2801-A  to  an 
external  screw  terminal  panel,  the  DT  707,  by  a  ribbon  cable 
and  connector.   The  DT  7  07  was  used  to  connect  AUV  sensor 
inputs,  the  command  output,  and  an  external  trigger  signal. 
Specific  configurations  are  discussed  later  in  this  chapter. 

The  following  summarizes  detailed  technical 
specifications  contained  in  the  manufacturer's  product 
literature  [Ref.  4]. 

1.   DT  2801-A  Digital  and  Analog  Signal  Processor 

This  device  supports  A/D  conversion  processing  on  8 
differential  analog  or  16  single  ended,  unipolar  or  bipolar, 
input  channels  with  12-bit  resolution.   Similarly,  there 
are  2  D/A  conversion  channels  for  processing  output  signals. 
Software  selectable  gains  accommodate  a  range  of  input 
signals.   With  12-bit  resolution  and  programmable  gains  it 
is  possible  to  achieve  a  conversion  accuracy  on  the  order  of 
+/-  0.03%  of  Full  Scale  Reading  (FSR) .   An  onboard  clock  can 
be  used  to  initiate  data  conversion  events  for  periods  of 
2.5  microseconds  to  0.819  seconds  in  1.25  microsecond 
increments.    For  more  precise  initiation  of  data  conversion 
events  or  to  synchronize  with  control  program  timing,  an 
external  trigger  input  is  also  available.   Throughput,  the 


time  to  execute  one  complete  read  or  write  cycle,  of  27.5 
KHz  can  be  achieved  under  Direct  Memory  Access  (DMA) 
procedures. 

The  onboard  processor  is  programmable  by  any 
language  that  can  access  I/O  registers  of  the  IBM  PC.  Also, 
pre-programmed,  user  callable,  subroutines  are  available  for 
use  with  this  device  under  the  product  name  PCLAB.   [Ref.  5] 
Similarly,  a  complete  Data  Acquisition  software  package, 
DT/NOTEBOOK  is  also  available.   [Ref.  6]    These  products 
were  used  in  this  research  and  are  described  in  later 
sections  of  this  chapter  and  in  chapter  3. 
2 .   DT  707  Screw  Terminal  Panel 

This  unit  along  with  the  ribbon  cable  and  connector 
facilitate  connection  of  I/O  channels  for  analog  to  digital 
signal  process  and  digital  to  digital  signal  processing. 
There  are  also  terminal  connections  for  external  trigger 
signal  sources. 

D.   SOFTWARE  INTERFACING,  ANALYSIS  AND  PROGRAMMING 

1.  Data  Acquisition 

This  phase  of  program  development  was  greatly 
facilitated  by  the  use  of  a  software  program,  DT/NOTEBOOK. 
[Ref.  6]   The  details  of  its  employment  and  the  system 
configuration  are  reported  in  the  next  section. 

2 .  Data  Analysis  and  AUV  System  Identification 
Assuring  the  capability  to  analyze  vehicle  test  data 

and  identify  discrete  transfer  function  relationships  was  a 


principal  objective  of  this  research.   This  analysis  was 
accomplished  and  reported  in  [Ref.  3]  using  a  CAD  Program 
called  MATRIXx  [Ref.  7]    This  program  affords  an  extensive 
set  of  design  and  analysis  functions  for  classical  and 
state-space  control.   It  also  provides  a  state-of-the-art 
matrix  analysis  and  graphical  display  capability. 
3 .   Control  Programming  Utilities  and  Language 

PC  LAB  consists  of  a  library  of  low  level  routines 
which  are  callable  as  procedures,  functions  or  subroutines 
in  the  following  high  level  programming  languages:   BASIC, 
FORTRAN,  Pascal,  Turbo  Pascal  and  C.   These  routines  include 
single  and  multiple  channel,  or  block,  A/D  and  D/A 
conversion,  with  buffered  storage  and  DMA  control  options. 
[Ref.  5]   It  should  be  noted  that  multiplexing  of  selected 
inputs  using  multiple  channel,  or  block  read,  procedures  is 
on  the  order  of  microseconds  when  using  the  DT  2801-A  signal 
processing  board.   [Ref.  4]   This  sample  interval  was 
considered  to  adequately  simulate  "instantaneous"  sampling 
of  discrete  vehicle  parameters.   Another  signal  processor, 
the  DT  2818,  is  advertised  to  have  "simultaneous  sample  and 
hold"  and  multiplexes  the  input  channels  on  the  order  of 
nanoseconds.   This  processor  may  have  application  in  future 
program  development. 

The  control  program  reported  in  Chapter  III  was 
written  in  Turbo  Pascal  and  compiled  to  run  under  either  PC 
DOS  or  MS  DOS  operation  systems.   [Ref.  8]   The  facility  of 
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the  Turbo  Pascal  program  development  environment,  the 
intrinsic  ability  to  manipulate  text  and  data,  the  screen 
graphics  capabilities  and  recursive  procedure  calls  were 
strong  considerations  in  the  selection  of  this  programming 
language.   Discussion  regarding  use  of  specific  PC  LAB 
routines  and  Turbo  Pascal  programming  are  presented  in 
Chapter  III. 

E.   DOCUMENTATION  AND  CONFIGURATION  FOR  AUV  DATA  ACQUISITION 
This  section  documents  the  configuration  of  hardware  and 
provides  commentary  on  the  application  of  the  DT/NOTEBOOK 
program  as  it  was  used  in  acquiring  data  during  actual  tank 
testing.   Figure  2.2  depicts  the  system  configuration  for 
this  phase  of  the  research. 

The  DT/NOTEBOOK  is  a  menu-driven  data  acquisition 
program  with  options  for  data  analysis.   (These  options  were 
not  used,  however,  in  favor  of  the  more  powerful  CAD  program 
MATRIXx  previously  discussed.)   The  DT/NOTEBOOK  program 
affords  a  high  level  user  interface  with  the  DT  2801-A 
signal  processor  and  was  used  exclusively  for  AUV  data 
acquisition  during  tank  testing.   The  comments  in  this 
section  are  intended  to  supplement  the  excellent  tutorial 
and  user  documentation  provided  with  the  DT/NOTEBOOK  program 
[Ref.  6]  with  comments  specific  to  this  research. 

During  the  AUV  trials  three  channels  of  analog  data  were 
sampled,  digitized  and  stored  for  subsequent  analysis.   The 
three  channels  of  sensor  data  consisted  of  depth,  from  a 
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transducer  output;  speed  from  a  dynamic  head  transducer,  and 
pitchrate  from  a  pitchrate  gyro.   The  configuration  of  the 
DT  2801-A/DT  707  terminal  panel  interface  with  the  AUV  is 
shown  in  Figure  2.3. 

DT/NOTEBOOK  uses  a  hierarchical  menu  concept  much  like 
Lotus  123.   Menu  selections  are  made  by  either  moving  the 
highlighted  input  box  with  the  cursor  keys  until  it 
"captures"  the  desired  option  and  then  pressing  the  <Enter> 
or  by  merely  pressing  the  key  corresponding  to  the  first 
letter  of  the  command  name.   As  successive  options  are  made, 
the  user  moves  deeper  into  the  menu  hierarchy.   At  each 
level,  a  new  menu  of  commands  or  data  input  options  is 
presented.   Pressing  the  <EXC>  key  moves  the  user  back  out 
of  the  menu  one  level  at  a  time. 

Figure  2.4  illustrates  the  Main  Menu.   The  program  is 
contained  on  12  disks.   The  first  of  these  is  a  "Key  Disk" 
which  must  be  inserted  in  Drive  A  during  installation  and 
whenever  the  program  is  first  executed.   Installation 
instructions  are  clear  and  specific  and  are  selected  from 
the  Main  Menu  using  the  INSTALL  command.   During  the 
installation,  two  directories  are  created  on  the  hard  disk: 
Drivers  and  Notebook.   Once  the  installation  has  been 
completed,  the  user  merely  locates  himself  in  the  Notebook 
directory,  inserts  the  Master  Key  in  Drive  A,  and  enters 
"nb"  from  the  keyboard.   The  program  then  displays  the  Main 
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SETUP   GO   ANALYZE   CURVE-FIT   FFT   INSTALL   PROGRAM   QUIT 
Perform  data  acquisition  /  control 


DT/NOTEBODK 

Figure  2.4   DT/NOTEBOOK  Main  Menu 

Menu  of  selections.   The  Master  Key  disk  may  then  be  removed 
and  is  not  needed  again  during  the  current  program  session. 

The  QUIT  command  exits  the  program  and  returns  to  the 
Disk  Operating  System  (DOS) .   The  PROGRAM  command  allows  the 
user  to  depart  the  Notebook  program  and  execute  programming 
in  DOS  and  then  return  to  Notebook  without  having  to  "re- 
boot" the  program  with  the  Master  Key  disk.   This  feature 
operates  must  like  a  programmable  interrupt  in  that  the 
"status"  of  Notebook  is  saved  for  the  period  that  the  user 
is  in  DOS  and  is  restored  upon  returning  to  the  Notebook 
program. 

The  CURVE  FIT  and  FFT  commands  are  intrinsic  program 
capabilities  for  curve  fitting  and  fast  fourier  transform 
operations  on  data  files.   The  ANALYSIS  command  permits  the 
user  to  call  an  external  analysis  program  of  the  user's 
choosing.   (Lotus  123  was  used  as  an  example  in  the 
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documentation.)   This  permits  analysis  and  graphical 
representation  from  within  the  Notebook  program.   These 
features  were  not  used  in  this  research.   Acquired  data  were 
analyzed  and  graphed  using  MATRIXx  as  a  stand-alone  program. 

The  remainder  of  this  sub-section  describes  the  data 
acquisition  process  used  extensively  in  this  research  and 
which  was  executed  using  the  SETUP  and  GO  commands  from  the 
Main  Menu.   Figure  2.5  depicts  a  flowchart  of  the  system 
configuration  "setup"  and  data  acquisition  initiation,  or 
"Go,"  process.   It  should  be  noted  that  once  a  suitable 
configuration  has  been  achieved  it  can  be  saved  as  a  setup 
file  and  recalled  for  future  use.   There  were  several  such 
files  saves  in  this  research,  however  the  file  named 
AUVSETUP  was  used  almost  exclusively  and  its  configuration 
is  reflected  in  the  figures  referenced  in  the  sub-section. 

From  the  Main  Menu,  selecting  the  SETUP  command  results 
in  the  presentation  of  five  configuration  commands  shown  in 
Figure  2.6. 

The  CHANNELS  command  allows  the  user  to  configure  the 
software  to  the  physical  hardware  connections  of  the  DT 
2801-A/DT  707  interface.   The  user  is  first  asked  to  choose 
between  NORMAL  or  HIGH  SPEED  data  acquisition.   The  NORMAL 
command  was  used  throughout  this  research.   The  HIGH  SPEED 
option  was  not  needed  for  the  sampling  required  in  this 
research.   This  mode  places  restrictions  on  data  display, 
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Figure  2.5   DT/NOTEBOOK  Data  Acquisition  Process 
Flowchart 
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Figure   2.6      DT/NOTEBOOK  SETUP   Command  Menu 
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Figure   2.7      DT/NOTEBOOK  NORMAL  Mode   Menu 
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memory  requirements  and  data  buffering  and  file  creation 
which  must  be  considered  if  this  mode  is  used. 

Selecting  the  NORMAL  command  results  in  the  presentation 
of  the  NORMAL  Mode  Menu,  Figure  2.7.   A  list  of  "setup 
conditions"  is  presented  down  the  left  side  with  a  column  of 
cells  for  user  entries  to  the  right.   Entries  are  made  by- 
using  the  cursor  to  "capture"  the  desired  cell  with  the 
highlighted  input  cell.   Configuration  specifications  are 
input  using  appropriate  keys  which  are  "echoed"  in  the 
Current  Value  cell  in  the  upper  left  hand  corner  of  the  menu 
display.   Pressing  ENTER  or  moving  the  input  cell  with  the 
cursor  key  enters  the  configuration  in  the  program.   The 
program  offers  some  specific  options  for  various  setup 
conditions  which  are  displayed  by  pressing  Fl.   It  should  be 
noted  that  the  DT  2801-A  can  sample  up  to  16  input  channels 
(0  ...  15)  and  these  are  specified  by  Interface  Channel 
Number.   The  user  must  recognize  the  distinction  between  the 
"data  channels"  specified  in  the  first  four  lines  of  the 
menu  and  the  interface  channel.   The  data  channels  are  user 
creations  based  upon  the  data  requirements.   The  interface 
channels  are  physical  input  connections  to  the  signal 
processor. 

In  this  research,  data  channel  1  was  always  configured 
as  TIME  and  used  to  record  elapsed  time  for  an  event  from 
the  DT  2801-A  processor  clock.   The  remaining  4  data 
channels  were  specified  to  receive  sensor  input  signals. 
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Figures  2.8-2.12  illustrate  these  configuration 
specifications. 

The  next  SETUP  command  is  FILES.   The  option  data  files 
are  configured  to  meet  user  requirements.   Figure  2.13 
illustrates  a  data  file  setup  which  was  used  for  most  of 
this  research.   There  are  two  points  which  need  to  be 
emphasized.   The  first  is  that  after  each  run,  the  user  must 
return  to  this  menu  and  change  the  "Data  File  Name."   If 
this  is  not  done,  NOTEBOOK  will  overwrite  the  new  data  into 
the  same  file.   Secondly,  the  data  field  specification  must 
be  specified  to  meet  the  input  data  file  requirements  of 
MATRIXx  if  the  acquired  data  are  to  be  analyzed  in  this 
program.   A  machine  executable  data  conversion  program 
(convdata.exe)  was  written  to  convert  NOTEBOOK  data  into 
MATRIXx  acceptable  data.   After  gaining  more  familiarity 
with  both  these  programs,  it  was  discovered  that  the  data 
conversion  program  was  not  necessary.   If  properly  specified 
in  the  NOTEBOOK  and  MATRIXx,  data  can  be  used  directly. 
Future  researchers  should  consider  the  experimental  data 
requirements  and  then  consult  the  documentation  of  these 
programs  to  effect  the  proper  configuration. 

One  last  documentation  remark  has  to  do  with  the  file 
naming  convention  used  in  this  research.   Conforming  to  the 
MS-DOW  rules  for  naming  files,  data  files  for  AUV  trials 
were  named  as  the  following  example  illustrates: 
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Current  Value:  1 

NORMAL  DATA  ACQUISITION  /  CONTROL  SETUP 
Nuaber  of  Channel*  5 

Current  Channel(s)  In  or  n..a)  1 

Channel  Type  Ttae 


Channel  Naae 


TIME 


For,,t  sssss.sss 

BuffnrSlze  "048 

Nuaber    of    Iterations  1 

Nuaber    of    Stages    ( 1..4]  j 

Saapllng    Rate,    Hz  20.000 

Stage    Duration,    aec.    [0.0..1  .OE  »08 )  20.000 

Start/Stop    Method  Noraal 

Trigger    Channel  1 

Trigger    Pattern    to    AND    (0..25S)  0 

Trigger    Pattern    to    XOR    [0..255]  0 

Tlae    Delay,    sec.    (  0.0..  1.0E  ♦  08  ]  0.000 

Analog    Trigger    Value  0.000 

Analog    Trigger    Polarity  High 

Nusber    of    Saaples    to    Save    (Pretrlgger)  0 


Figure    2.8      DT/NOTEBOOK   Channel    1   Configuration 


Current     Value:    '.' 

NORMAL    DATA    ACQUISITION    /    CONTROL    SETUP 

Nuaber    of    Channels  5 

Current    Channel(s)    (n    or    n..a]  2 

Channel    Type  Analog    Input 

Channel    Naae  PITCH    HATE 

Interface    Device  Q:    DT2801A 

Interface    Channel    Nuaber    (0.15)  2 


Input    Range  qt.25    V 

Scaler' actor  1000 

Offset    Constant  0.000 

Buffer    Size  2048 

Nuaber    of    Iterations  1 

Nuaber    of    Stages    (1..4)  1 

Saapllng    Rate,    Hz  20.000 
Stage    Duration,    aec.    (0.0..1.0E  *08  )                    20.000 

Start/Stop   Method  Noraal 

Trigger    Channel  I 

Trigger    Pattern    to    AND    (0..255)  0 

Trigger    Pattern    to    XOR    10. .255)  0 

Tlae    Delay,    sec.    (0.0..1.0E -08  I  0.000 


Figure   2.9      DT/NOTEBOOK  Channel    2    Configuration 
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Current     Value: 

NORMAL    DATA    ACQUISITION    /    CONTROL    SETUP 

Nuaber    of    Channels  5 

Current    Channel(s)    [n    or    n..a)  3 

Channel    Type  Analog    Input 

Channel    Nana  DEPTH 

Interface    Device  0:    DT2S01A 

Interface    Channel    Nuaber    ( 0     15  1  6 
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Scale    Factor 

Offset    Constant 

Buffer    Size 

Nuaber    of    Iterations 

Nuaber    of    Stages    11.4) 


qlO    V 

1.000 

0.000 

2048 

1 

1 


Saapllng    Rate.    Hz  20.000 

Stage    Duration,    sec.    [0.0..1 .0E  ♦  08  1  20.000 

Start/Stop    Method  Noraal 

Trigger    Channel  1 

Trigger    Pattern    to    AND    (0.255)  0 

Trigger    Pattern    to    XOR    10. .255]  0 

Tlae    Delay,    sec.    I0.0..1.0E*08)  0.000 


Figure   2.10      DT/N0TEB00K  Channel    3    Configuration 


Current    Value:    4 

NORMAL    DATA    ACQUISITION    /    CONTROL    SETUP 

Nuaber    of    Channels  5 

Current    Channel(s)    In    or    n.a)  * 

Channel    Type  Analog    Input 

Channel    N.ae  DIVE    CMD 

Interface    Device  0:    DT2801A 

Interface    Channel    Nuaber    {0.151  8 


Input    Range 

Scale    Factor 

Offset  Constant 

Buffer  Size 

Nuaber    of    Iterations 

Nuaber    of    Stage*    (1-4) 

Saapllng    Rate,    Hz 

Stage    Duration,    tec.    [0.0..1.0E  +  08] 

Start/Stop    Method 

Trigger    Channel 

Trigger    Pattern    to    AND    (0..2551 

Trigger    Pattern    to    XOR    (0..2S51 

Tlae    Delay,    sec.    [0.0..1.0E-08 ) 
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Figure   2.11      DT/NOTEBOOK  Channel    4    Configuration 
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Current     Value:    5 

NORMAL    DATA    ACQUISITION    /    CONTROL    SETUP 

Nuaber    of    Channels  5 

Current     Cbannel(s)    [n    or    n,.a]  5 

Channel    Type  Analog     Input 

Channel    Naae  PITCH    ANGLE 

Interface    Device  0:    DT2301A 

Interface    Channel    Nuaber    (0..1S]  •                          4 

Input     Range  q  1  0    V 

Scale    Factor  1.000 

Offset    Constant  0  000 

Buffer    Size  204!) 

Nuaoer    of    Iterations  1 

Nuaber    of    Stages    11. .4)  1 

Saapllng    Rate.    Hz  20.000 

Stage    Duration,    sec.    (0.0..  1.0E»  08 1  20.000 

Start/Stop    Method  Noraal 

Trigger    Channel  1 

Trigger    Pattern    to    AND    (0.  255)  0 

Trigger    Pattern    to    XOR    10. .2551  0 

Tlae    Delay,    sec.    (0  .0..  1  .  0 1  •  08  )  0.000 


Figure   2.12      DT/NOTEBOOK  Channel    5   Configuration 


Current     Value:     1 


FILES    SETUP 


Nuaber    of    Data    Files    (0..12)  1 

Current    Data    File    11. .1J  1 

Data    File    Naae  AV010915.DAT 

Storage    Mode  ASCII    Real 

Nuaber    of    Header    Lines    (0..4)  4 

Header    Line    1  AUV    SYSTEMS    IDENTIFICATION    DATA 

Header     Line    2  9    JAN     1988     :    RUN     15 

Header    Line    3  The    tlae    Is    ST1ME. 

Header    Line    4  The    date    Is    SDATE. 

Nub.    of    Channels    In    File    (0.100)  5 

File    Channel    Nuaber  12  3  4  5 

Channel    Nuaber  12  3  4  5 

Channel    Naae  TIME    PTCHRATE  DEPTH    DIVE    CMD    PTCHANCL 

Channel    Units  Seconds  volts  volts  volts  VOLTS 

Field   Width    (ASCII    Files)  12  12  12  12  12 

Declaal    Places    (ASCII    Real    Files)  4  4  4  4  4 


Figure   2.13      DT/NOTEBOOK   Data   Files   Setup 
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AV010915.DAT 
denotes  AUV  data  acquired  from  NOTEBOOK 
denotes  the  month  of  the  trial,  i.e.,  January 
denotes  the  day  of  the  month  of  the  trial 
denotes  the  particular  trial  for  the  day 
was  the  extension  used  for  all  data  files. 


Files  which  were  converted  by  the  data  conversion  program 
for  analysis  with  MATRIXx  were  named  by  the  same  convention 
except  "UV"  was  used  for  the  first  two  characters.   Thus  the 
file  UV010915.DAT  would  indicate  that  this  is  the  data  file 
converted  from  AV010915.DAT  for  use  with  MATRIXx. 

The  next  SETUP  menu  option  is  DISPLAY.   This  command 
specifies  the  setup  for  the  real-time  display  of  data  as  it 
is  being  acquired.   This  feature  is  most  beneficial  in 
evaluating  the  quality  of  the  data  collected.   It  should  be 
noted  that  in  achieving  a  visual  display  the  program  invokes 
a  liberal  "graphical  license"  and  so  the  displays  afford  a 
relative  measure  and  not  an  exact  replication  of  the  data 
acquired.   The  stored  data  file  is  unaltered  by  the  display 
configuration  specification. 

The  DISPLAY  command  presents  the  user  with  two  menus: 
WINDOW  SETUP  and  TRACE  SETUP.   In  these  menus  the  user  can 
specify  the  number,  size  and  type  of  the  display  windows  and 
the  data  trace  characteristics.   There  is  considerable 
flexibility  and  the  program  documentation  should  be 
consulted  to  exploit  this  feature.   Figures  2.14  and  2.15 
illustrate  configurations  used  in  this  research  to  display 
three  windows  and  their  respective  traces. 


24 


Current     Value: 

WINDOW    SETUP 
Nuaber    of    Windows    (0..1S)  3 


Window    Nuaber 

1 

2 

3 

Left        Llalt.    xO    [0.0. .1.0) 
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Upper    Llalt,    yl     [0.0.  .1.0) 
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Y    Axis    Title 

PTCIinT    V 

DEPTH    ' 

i        DVCMD 

X    Axis    Title 

TIMK/SEC 

TIME/SEC 

TIME/SEC 

Length    of    Tlae    (X)    Axis    In 

SBC. 

30.000 

30.000 

30.000 

X    Tic    Start     Value 

0.000 

0.000 

0.000 

X    Tic    End    Value 

30.000 

30.000 

30.000 

Nuaber    of    X    Tics    [0.11] 

7 

7 

7 

Y    Tic    Start    Val 

Figure    2.14      DT/NOTEBOOK  Window   Setup   Configuration 


Current    Value:    4 

TRACE    SETUP 

Nuaber    of    Traces    [0..50]  4 

Trace    Nuaber  12  3  4 

Window    Nuaber    [1..15J  12  3  2 

Line    Color  Black  Red  White         Yellow 

Line    Type  Solid  Solid  Solid  Solid 

Data    Point    Syabol  None  None  None  None 

Y  Channel    Nuaber  2  3  4  5 

Y  Mlniaua    Displayed    Value  -0.500  0.000  -0.500       -10.000 

Y  Maxiaua    Displayed    Value  0.500         10.000  0.500         10.000 

Trace    Type  T    vs.    Y      T    vs.    Y      T    vs.    Y      T    vs.    Y 

For    Meters    Only:  ' 

Nuaber    of    Declaal    Places  3  3  3  3 

For    Type    XY    Only: 

X    Channel    Nuaber  12  3  4 

X    Mlnlaua    Displayed    Value  0.000  0.000  0.000  0.000 

X    Maxiaua    Displayed    Value  10.000  10.000  10.000  10.000 


Figure   2.15      DT/NOTEBOOK  Trace   Setup  Configuration 
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The  next  SETUP  is  VERIFY.   Executing  this  command 
displays  a  screen  which  reflects  the  configuration  which  a 
user  has  specified.   This  provides  a  good  check  of  the 
system  setup. 

The  last  SETUP  command  is  SAVE/RECALL.   As  the  title 
suggests  this  command  allows  the  user  to  save  a  particular 
configuration  setup  as  a  specific  file  or  to  recall  such  a 
file  for  reuse. 

Once  a  system  configuration  has  been  specified  and  the 
AUV  is  connected  to  the  DT  2801-A/DT  707  interface,  actual 
data  acquisition  is  initiated  by  selecting  the  GO  command 
from  the  Main  Menu.   In  its  default  configuration,  the 
program  will  commence  data  acquisition  as  soon  as  GO  is 
selected.   However,  a  useful  feature  is  the  "Keystroke 
Before  Run"  which  is  selectable  in  the  INSTALL,  OPTIONS 
commands.   This  delays  the  beginning  of  data  acquisition 
after  GO  is  selected  until  "any  other  key"  is  depressed. 
This  feature  was  used  throughout  this  research  as  it 
permitted  more  precise  control  over  the  data  acquisition 
events . 

F.   DOCUMENTATION  AND  CONFIGURATION  FOR  AUV  CONTROL 

Figure  2.16  depicts  the  system  configuration  for  control 
of  the  AUV  under  high-level  language  control  programming. 
Figure  2.17  shows  a  schematic  of  the  DT  707  terminal 
connections.   Owing  to  the  non-availability  of  the  test  tank 
and  suitable  radio  transmitter  interface  module  to  transmit 
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the  generated  dive  plane  command  to  the  AUV,  real-time 
control  was  not  accomplished  in  this  research.   Figure  2.18 
shows  the  system  configuration  used  to  simulate  real-time 
control  configuration  in  the  development  and  verification  of 
the  control  program.   Details  of  the  program  development  and 
verification  are  reported  in  Chapter  III  of  this  thesis. 
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III.   PROGRAMMING  VERIFICATION 

This  chapter  reports  on  the  final  objective  of  this 
thesis:   verification  of  I/O  processing  of  analog  and 
digital  signals  under  higher-level  program  control.   The 
following  sections  discuss  the  design,  implementation, 
verification  and  documentation  of  this  program.   A  complete 
and  documented  listing  of  the  main  program  is  contained  the 
Appendix. 

A.   PROGRAM  PERSPECTIVE  AND  DESIGN 

The  introduction  of  [Ref.  2]  presents  a  concise 
description  and  illustration  relating  this  concept  to  this 
and  other  current  research  at  the  Naval  Postgraduate  School, 

The  theory  of  classical  (closed  loop)  controllers  as  well 
as  modern  state-space  design  of  Digital  Autopilots  are 
further  discussed  in  [Refs.  10,11].   In  its  final 
implementation,  a  digital  autopilot  will  control  all  six 
degrees  of  freedom  of  the  AUV  in  the  execution  of  a  variety 
of  missions  and  in  a  diversity  of  operating  environments. 
The  architecture  of  the  autopilot  will  reflect  extensive 
functional  modularity.   Under  the  supervisory  control  of  an 
"AUV  Operating  System,"  missions  will  be  executed  as  a 
sequence  of  tasks  compiled  and  ordered  by  the  onboard 
planning  logic  and  knowledge  database.   Similarly, 
completion  of  these  tasks  will  reflect  the  compilation  and 
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execution  of  functional  capabilities  in  sequence  or  in 
parallel  under  the  control  of  a  lower-level  operating 
system.   These  functional  capabilities  may  well  be 
implemented  as  multi-processors  each  reflecting  a 
hierarchical  organization  specific  to  their  required 
functional  responsibility. 

Timing  will  be  a  critical  to  the  successful  assimilation 
of  functional  modules  and  the  accomplishment  of  tasks  and 
missions.   The  top  level  "AUV  Operating  System"  will  provide 
a  master  synchronizing  timing  signal  based  optimal 
considerations  of  the  cycle-time  requirements  of  the 
subordinate  processors.   Cycle-time  is  the  time  required  to 
receive,  process  and  transmit  information.   Cycle-time  will 
be  most  affected  by  the  processing  interval.   Modern  digital 
controller  design  must  therefore  concern  itself  with 
optimizing  response  and  processing  time  requirements. 

A  Model-Referenced  Autopilot  design  was  evaluated  and 
found  to  be  most  suited  to  control  of  the  rapid  maneuvering 
and  changing  environmental  and  "plant"  parameters  which  will 
be  encountered  in  an  AUV  [Ref.  2]   In  contrast  to  the 
classical  accomplishment  of  vehicle  maneuvers  through  the 
independent  action  of  rudder  and  diveplane  for  course  and 
depth  control,  a  Model  Referenced  design  will  be  a 
multivariable  control  structure.   It  will  require  the 
parallel  processing  of  vehicle  sensory  data  to  determine  a 
vehicle  state,  comparison  with  a  model  reference  state  and 
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the  determination  of  an  appropriate  command.   As 
verification  of  the  on-site  program  development  capability, 
this  research  sought  to  investigate  the  cycle  time 
requirements  of  a  high-level  language  control  program  which 
emulated  the  modular  organization  of  a  model  referenced 
controller  and  exercised  the  signal  processing  functions  of 
the  DT  28  01-A  hardware  and  software. 

B.   PROGRAM  IMPLEMENTATION 

This  program  represents  a  functional  module  at  the 
lowest  level  of  the  digital  autopilot  hierarchy:   the 
analog-digital  interface  between  the  AUV  servo-controllers 
and  the  onboard  digital  processing  capability.   As  discussed 
in  Chapter  II,  the  verification  process  was  simulated  using 
signal  generators  (Figure  2.18).   Three  analog  sensory 
signals,  simulated  by  inputs  from  signal  generators  are 
sampled.   These  signals,  represent  AUV  transducer  outputs 
for  depth,  speed  and  pitchrate.   The  amplitude  of  these 
signals  are  representative  of  actual  AUV  signals  measured 
during  tank  testing.   Respective  ranges  of  amplitudes  of 
these  signals  are  +/-  10,  +/-  5,  and  +/-  1.25  volts.   The 
sampled  analog  signals  are  then  processed  by  the  program: 
the  speed  and  pitchrate  signals  are  processed  for  display 
only;  the  depth  signal  is  processed  by  the  control  modules 
which  generate  an  outgoing  command  (voltage)  to  the 
diveplane  actuator  channel.   An  external  trigger  simulates 
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the  master  timing  signal  as  it  might  be  implemented  in  an 
actual  processor  onboard  an  AUV. 

The  program  implements  a  closed  loop  control  process 
within  a  user  interface  shell.   As  depicted  in  the  program 
pseudo-flow  chart  (Figure  3.1),  the  user  enters  a  desired 
AUV  target  depth  and  then  turns  control  of  the  AUV  over  to 
the  control  loop.   It  was  intended  that  the  user  have  the 
facility  to  interrupt  the  control  sequence  by  pressing  key 
<F1>  to  enter  a  new  target  depth,  <F2>  to  halt  the 
controller  and  reset  the  program,  or  <ESC>  to  exit  the 
program.   It  was  discovered  in  the  final  assembly  of  the 
program  modules,  however,  that  the  PCLAB  signal  processor 
routines  masked  the  keyboard  interrupt  device  thus  denying 
access  to  programmable  interrupts  for  program  control . 
Although  this  problem  did  limit  the  interactive  features  of 
the  program,  it  did  not  interfere  with  the  active  control  or 
validation  of  the  development  system.    This  problem  is 
discussed  in  Chapter  IV. 

This  program  utilizes  routines  which  are  provided  with 
the  PCLAB  real-time  software.   In  many  of  the  compiled 
language  implementations  which  includes  Turbo  Pascal, these 
routines  are  programmed  as  functions  which  return  integer 
error  codes  as  well  as  passing  analog  or  digital  data 
values.   Programming  these  routines  is  accomplished  by 
declaring  an  integer  variable  and  then  calling  the  desired 
routine.   For  example,  STATUS  is  the  declared  integer 
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Figure    3.1      Closed   Loop   Control    Program   Flow  Chart 
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variable  used  in  the  program  code.   Calling  a  single  value 

Analog  to  Digital  conversion  is  accomplished  with  the 

following  statement: 

status=  adcvalue  (<channel  " , <gain>, <user  declared 

data  variable  >) 

<    >  denote  required  declarations 
Literally  interpreted,  this  statement  says  that  "Status  gets 
the  integer  error  code  of  the  function  adcvalue."   Error 
codes  are  automatically  processed  by  an  error  processor  and 
if  an  error  is  encountered  in  the  data  conversion,  an  error 
message  is  printed  to  the  display  screen.   The  data  values 
are  passed  to  the  program  as  value  parameters  and  may  be 
treated  as  any  other  data  parameter  in  program  coding  and 
manipulation.   PCLAB  reportedly  supports  single  or  block 
data  conversion  routines.   However  several  attempts  to  use 
the  block  routines  to  convert  data  from  selected  sensor 
channels  were  not  successful.   This  problem  is  discussed  in 
Chapter  IV. 

The  following  sub-sections  supplement  the  program 
commentary  found  in  program  listing  (Appendix) ,  and  describe 
the  salient  modules  which  implement  the  Closed  Loop  Control 
routine.   The  titles  of  the  subsections  correspond  to  the 
title  of  the  program  modules  as  listed  in  the  Appendix. 
Appendix  D  [Ref.  5]  contains  the  algorithms  for  analog  and 
digital  conversions.   These  have  been  used  in  the  following 
procedures  where  such  data  manipulation  is  required. 
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1.  Initialize  Zero  Digital  Signal  Out 

This  routine  must  executed  at  the  beginning  of  the 
program  so  as  to  send  a  zero  voltage  digital  signal  out. 
The  DT  2801-A  defaults  to  sending  out  a  minimum  full  scale 
reading  out  as  soon  as  it  is  powered  up.   It  is  therefore 
important  to  "zero"  the  output  signal  before  attaching  the 
test  vehicle.   This  routine  "zeroes"  the  signals  of  both 
analog  to  digital  output  channels. 

2 .  Convertspeed.  Convertdepth  and  Convertpitchrate 
These  are  three  functions  which  convert  digital-to- 
analog  data  values  to  AUV  parameters.   The  algorithms  for 
these  conversions  are  based  on  tank  tests  conducted  on  the 
AUV  and  are  reported  in  [Ref.  3] 

3 .  GetTargetDepth 

This  procedure  solicits  the  AUV  operating  depth  from 
the  user  (an  integer  input)  and  converts  it  to  an  analog 
voltage  based  upon  the  depth  to  voltage  relationship  derived 
during  testing.   This  equivalent  analog  voltage  is  passed  to 
the  control  program  for  control  processing. 

4 .  GetDigitalSensorvData 

This  procedure  samples  three  channels  of  sensory 
input  and  converts  them  to  AUV  analog  equivalent  values 
using  the  previously  mentioned  functions.   These  values  are 
then  passed  to  the  control  program  as  representing  the  state 
of  the  AUV.   Several  designs  were  envisioned  using  single 
and  block  data  transfers  so  as  to  achieve  a  suitable 
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throughput  and  synchronization  of  this  event.   ADConTrigger 
is  a  single  value  conversion  routine  which  executes  on  the 
high  to  low  transition  of  an  external  trigger.   As  soon  as 
this  conversion  is  completed,  two  ADCValue  commands  convert 
data  for  the  remaining  two  sensory  channels.   Timing  studies 
for  a  single  value  conversion  affirmed  a  throughput  on  the 
average  of  0.6  msec.   The  throughput  for  the  one  triggered 
and  two  single  value  conversions  averaged  2.5  msec. 

5.  Errorvolts 

This  procedure  computes  a  difference  or  error 
voltage  between  the  analog  voltages  for  target  and  actual 
depths.   A  "voltage  filter"  has  been  implemented  to  permit  a 
tolerable  difference  range  above  and  below  the  target  depth. 
This  precludes  trying  to  achieve  an  absolute  zero  difference 
which  is  an  not  a  practicable  design  in  manipulating  the 
digital  to  analog  conversions.   It  also  allows  the  AUV  a 
defined  range  in  which  no  changes  in  plant  operating 
parameters  are  required  to  maintain  a  desired  depth.   The 
computed  error  voltage  is  then  passed  to  the  control  program 
for  processing  by  the  GenerateDiveCommand  module. 

6.  GenerateDiveCommand 

This  procedure  simply  converts  the  computed  error  or 
difference  voltage  to  an  analog  equivalent  and  sends  this 
signal  out  on  the  specified  analog  to  digital  channel. 
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C.  PROGRAM  VERIFICATION 

The  verification  configuration  and  objectives  have  been 
previously  stated.   The  evaluation  of  the  cycle  time 
requirement  is  based  on  the  minimum  required  AUV  sampling 
time  in  order  to  maintain  real-time  control.   A  critical 
real-time  control  interval  of  50  msec  or  a  sampling  rate  of 
20  Hz  was  established  as  a  standard  based  upon  evaluation  of 
data  collected  and  reported  in  [Ref.  3]. 

Notwithstanding  the  problems  encountered  with 
programmable  interrupt  control  and  block  data  conversions 
using  the  PCLAB  routines,  high-level  program  control  of  the 
analog  and  digital  I/O  signal  processing  was  achieved. 
Cycle  times  were  measured  at  various  sampling  rates  as 
simulated  by  the  frequency  of  the  external  trigger  signal. 
Figures  3.2-3.4  show  the  results  of  these  timing  studies.   A 
cycle  time  on  the  order  of  5  msec  was  recorded.   This  cycle 
time  is  well  within  the  required  limit  and  affords  an  ample 
marqin  for  more  extensive  sensor  sampling,  control 
processing  and  multiple  command  generation. 

D.  PROGRAM  DOCUMENTATION 

The  documentation  of  the  program  listing  and  the 
previous  sections  in  this  chapter  have  described  the  logic 
and  function  of  the  program.   This  section  documents  the 
filenames  and  other  information  which  may  assist  follow-on 
research. 
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The  control  program  is  named  AUVPILOT  with  extensions  of 
•PAS  and  .COM  for  the  Turbo  Pascal  and  executable  machine 
codes,  respectively.   The  included  files  declared  at  the 
beginning  of  the  program  listing  (Appendix)  all  have  a  file 
extension  .AUV.   These  programs  provide  utility  support  for 
screen  displays  and  program  timing.   Some  of  these  programs 
are  adaptations  of  routines  discussed  in  [Ref.  9],  while 
others  were  created  to  meet  specific  needs  of  the  main 
program. 

The  Turbo  Pascal  v  3.0  programming  environment  and 
language  features  are  thoroughly  explained  in  [Ref.  8].   No 
additional  explanation  is  considered  necessary.   One  major 
consideration  in  the  utility  of  this  programming  language  is 
that  in  the  recently  released  4.0  version,  the  code  size 
limitation  of  64K  bytes  has  been  eliminated  thus  making  it 
suitable  for  very  large  program  applications.   The 
compatibility  problems  with  PCLAB  routines  still  remain  to 
be  resolved,  however.   PCLAB  does  not  as  yet  support  this 
latest  version. 
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IV.   SUMMARY.  CONCLUSIONS.  AND  RECOMMENDATIONS 

A.  SUMMARY 

The  thesis  has  described  the  hardware  and  software 
details  of  an  IBM-PC  based  controller  as  a  shell  for  further 
development.   The  software  has  been  used  for  digital  data 
acquisition  and  cycle  time  studies  have  been  performed  for 
throughput  of  control  signals  operating  from  an  external 
trigger  source. 

B.  CONCLUSIONS 

The  work  of  this  thesis  demonstrated  the  ability  of  an 
IBM-PC  based  microcomputer,  coupled  with  an  advanced  D/A  and 
A/D  conversion  board  to  provide  both  data  acquisition  and 
control  functions  that  will  be  required  in  any 
implementation  of  an  intelligent  controller  for  Automated 
Underwater  Vehicles. 

Cycle  time  for  sensing  three  signal  channel  inputs, 
computation  of  tracking  error,  and  sending  of  updated 
control  signals  is  5  msec.   With  a  sample  time  of  0.05 
seconds,  45  msecs  are  available  for  storing  data,  updating 
vehicle  parameter  estimates,  and  interfacing  with  higher 
level  supervisory  control  programs.   The  trigger  for  sample 
initiations,  at  present,  is  timed  by  an  external  clock. 

The  structure  implemented  herein,  is  now  capable  of 
being  expanded  to  incorporate  the  control  signal 
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formulations  necessary  to  achieve  full  implementation  of  an 
automated  digital  autopilot. 

C.   RECOMMENDATIONS 

The  problems  with  programmable  interrupt  control  and 
multiple,  or  block,  data  conversions  discussed  in  Chapter 
III  present  several  issues  which  need  to  be  resolved. 
First,  if  Turbo  Pascal  is  to  be  used  in  future  research, 
these  problems  will  have  to  be  resolved  through  direct 
correspondence  and  consultation  with  the  development  firm. 
Furthermore,  the  near-term  availability  of  PCLAB  routines 
for  Turbo  Pascal  v  4.0  should  be  assured  so  as  to  support 
development  of  large  control  programs.   At  this  juncture  in 
the  research,  it  is  perhaps  best  to  evaluate  other  compiled 
high-level  languages  with  respect  to  the  stated  benefits  of 
Turbo  Pascal  and  the  programming  requirements  of  more 
complex  Digital  Autopilot  implementations.   Program 
interfacing  with  other,  more  "intelligent"  digital  control 
modules  should  also  be  considered  so  as  to  assure  future 
integration  of  program  modules  under  development  by  the 
various  departments  at  the  Naval  Postgraduate  School. 
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APPENDIX 

LISTING    OF    CONTROL    PROGRAM    CODE 
program         AuvAutoPllot      (    Input,    output    ); 

(    TITLE  :    Autonomous    Underwater    Vehicle    Auto    Pilot    Prograa. 

AUTHOR  :    CDR    Stephen    W.    Delaplane,    USN 

APPLICATION    :    Partial    fulfillment    of    Thesis    Research    for    the    degree 

Masters    of    Science    in    Mechanical    Engineering. 
DATE  :    18    March    1988 

Project    Description    :    This    prograa    lapleaents    digital    control    of    the    NPS 
autonoaous    underwater    vehicle    (AUV)    in    the    vertical    or    dive    plane.it    saaples 
vehicle    sensor    Input    froa    three    channels    :    depth,    speed,    pitchrate.      The 
depth    signal    is    then    passed    to    a    DepthError   module    which    coapares    the    actual 
sensor    depth    with    a    aodel    reference    depth    siaulated    by    a    depthgain.      A    depth 
error    voltage    is    then    generated    and    passed    to    a   GenerateOivePlaneCoaaand 
aodule    which    processes    the    error    signal    and    sends    out    an    appropriate    coaaand 
to    the    dlveplane    actuators.    The    gains    in    the    algorithas    reflect    the    discrete 
transfer    function    gains    for    dlveplane    coaaand    response    derived    froa    vehicle 
Identification    analysis.  } 


{    GLOBAL    DECLARATIONS 


const 

._  _  __   C/* 

l  ~  ~ 

5Creen  u 

xl 

yi 

x2 

y2 

=  5; 
=  2; 
=  75; 
=  24; 

type 

strlO  = 
str60  = 

1  string 
•  string 

[101; 
[601; 

} 


{  Upper  left  corner  :  left  edge  } 

{  Upper  left  corner  :  upper  edge  } 

{  Lower  right  corner  :  right  edge  } 

{  Lower  right  corner  :  bottoa  edge  } 


var 

hr,hr2,ain,aln2, 

sec,sec2,hun,hun2  :   byte; 

seconds  :    real; 

option,   controlaode, 

reply, reply2  :   char; 


INCLUDED   FILES   Declarations 


(SI    pcldefs.tp      }         (PC    LAB    Trubo    Pascal    routines.  ) 

{SI    pclerrs.pas    )         (PC    LAB    error    code   aessages    file.  } 

(Slinidac.auv         ) 

{    This    procedure    initializes    the    DT    2801-A    TO  ZERO   VOLTS   AND    MUST   BE 
EXECUTED      BEFORE    THE   AUV    IS    HOOKED    TO   THE   COMPUTER.         It    is    called    as 
procedure    Inl tlallzeZeroDlgit alSlgnalOu t.  } 

(SIgettlme.auv      }         {      No    arguments;    returns    hr,   Bin,    sec,   hun    :    byte  ) 

{Jlshotmdff.auv    ) 

{    Input    the    output    of   TlaeDlff.auv    and    this    procedure   displays    the    time 

difference    between    the    two    most    current    GetTlae.auv    results. 

ShowTimeDif ferene   (   x:lnteger)   .  ) 
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{Slttaediff.auv} 

{    Input:    hr,hr2,aln,aln2,sec,sec2,hun,hun2    froa    two   calls 

of    Get  Tlme.au v    and    this    returns    the    difference    In 

seconds    as    a   REAL    variable. 

($Idrawbox2.auv) 

(    Input    xl,yl,x2,y2    :    Integer    to    specify    the    corner    Halts    of    the    box. 
This    procedure    clears    screen    and    draws    a    rectangular    box   of    specified 
dimension    using    ASCII    double    line    characters.  } 

(SIclrbox2.auv) 

{    Input    xl,yl,x2,y2    :    Integer    to    specify    the   corner   Halts    of    the    box. 

This    procedure    uses    a    FAST    leans    of    clearing    a    box    of    specified    dimension. 

The    box    dimension    should    be    delcared    as    constants. 

(Hboxprint.auv    ) 

{    Input    the    prlntrow,    leftboxedge,    rlghtboxedge      :    Integer    and    printstrlng   : 

str60.      This    procedure    centerprints    the    string   In    the    box   at    the    prlntrow 

specified    without    overwriting    the    box   border. 

(Slshowf  ast.auv) 

(    Input    aessage    :    str60,    coluan,row    :    Integer.      To    specify    the    x,y    position 

on    the    screen    for    a    FAST   aessage   print. 

(Slkeyhlt.auv) 

{   This    Is    a   boolean    function   which   returns    true   or    false    If   key    Is    pressed; 

It    also    returns    keycode    replies    VAR    reply,    reply2    :   char  } 

(Jltabxy.auv) 

{    Input    t  abcol.tabrow    :    Integer;    like    gotoxy  > 

(SIboxpause.auv) 

{    Input    xpause.ypause    :    Integer    to    specify    where    "Press    any   key    to    continue" 
aessage    is    to   be   printed. 

{SIgetkey.auv    } 

{   Input    as    a    string   of   chars,    the    set    of   acceptable    replies;    le    'YyNn'.      This 
procedure   waits    until    one    of    the    acceptable    replies    has    been    entered.  } 

(Slutils.auv      } 

{    Included   are    soae   housekeepplng   and   debugging    routines.  } 

(IIconvadv.au v    } 

(    Includes    functions    to   convert    depth, speed    and   pltchrate    to    vehicle   values.    } 
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{    .uttMi.iMii.ii       MAIN    PROGRAMS    PROCEDURES  «*«*«»**«»««««  t  iiuiitiii  sex 

{    itiuii «ti    USER    INTERFACE    MODULES  ««««««*««««««»««««*««*«««««« 

procedure    MainMenu    (    var    reply    :    char    ); 

{      This    procedure    presents    the    AUV    screen    and    solicits    an    option    to    Run 

the    AUV    froa    the    St atusAndCoaaand    procedure    or    to    Quit.  } 

begin 

repeat 

clrscr; 

drawbox2(xl,y  I,x2,y2); 

boxprlnt<yl  +  3,xl,x2,'N   AVAL         POSTGRADUATE         SCHOO   L'); 

boxprint(yl  +  5,xl,x2,'D    EPARTMENT        OF'); 

boxprint(yl  +  6,xl,x2,"M    ECHANICAL         ENGINEERIN   G'); 

boxprint(yl +8, xl,x2, "AUTONOMOUS         UNDERWATER         VEHICLE'); 

boxprint(yl  + 10, xl,x2, 'DIGITAL         AUTOPILOT      CONTROL        PROGRAM'): 

boxprint(y  1  +  12, Xl,x2,'"*"  "*"*""***""«  ***«*»«"*«*«« *"'); 

boxprint(yl  +  l5,xl,x2,'Do  You  want  to  RUN  this  program  ..'); 

boxprint(yl  +  16,xl,x2,'or  Do  You  want  to  QUIT  and  return  to  DOS  ?'); 

boxprint(yl  +  20,xl,x2,'»>>   ENTER  Q  OR  R   <«<'); 

getkey  CQqRr", reply, reply2); 
until  (  reply  in  ['Q','q7R','r']  )  and  (reply2  =  chr(0)); 
end; 

procedure  St atusAndCoaaand  (  var  aode  :  char  ); 

{  This  procedure  begins  the  control  prograa   screen.  } 

var 

aode2  :  char; 

procedure  StatusAndCoaaandScreen; 

{   This  is  the  status  and  control  screen  and  solicits  a  user  input  of  Fl  to 

RUN  the  prograa  or  Q  to  Quit  and  exit  to  the  aain  aenu.  } 

begin         {  StatusAndCoaaandScreen  ) 

clrbox2  (xl,yl,x2,y2); 

boxprint(yl  +  l,xl,x2,*AUV  STATUS  /  COMMAND  AND  CONTROL  SCREEN*); 

boxprint(yl*-2,xl,x2,'=  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  ===  =  =  =  =  =  =='); 

boxprint(yl+7,xl,x2,'CHOOSE    YOUR   DESIRED    CONTROL   MODE      :'); 
boxprlnt(yl  +  9,xl,x2,'ENTER    KEY      <<    Fl    »         TO   START   AUV   CONTROL'); 
boxprint(yl  +  ll,xl,x2,'ENTER      «    Q    »    TO   QUIT   AND   RETURN    TO   MAIN    MENU'); 
boxprint(yl*16,xl,x2, "PRESS    EITHER         Fl         OR      Q'); 


end;  {    StatusAndCoaaandScreen 
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{    tiMtiitiiiiiiiuiMMi    CLOSED    LOOP    CONTROL    ROUTINES    «««***«****«****«««* 

procedure    ClosedLoopControl; 

{    This    module    comprises    the    closed    loop    control    scheme.  } 

const 

maxdepth  -    33; 

■lndepth  =    0; 

upda  t  eincreien  t  =     10; 

type 

act ivecont rolaode         =    (    run,    reset,    exit    ); 

allow  abledept  hrange    =    alndept  h..aaxdept  h    ; 

auvattitude  =    (    climb,   aalntain,    diving    ); 

dlgitallntegerarray      =    array    [1..3]    of    integer; 

var 

auvdepth,    auvdepthvolts.auvspeed, 

au  vspeedvol  t s,    au vpl t chr ate,    auvpltchratevolts, 

depther ror volt s,    targe tdepthvolt s  :    real; 

adv  :    dlgitallntegerarray; 

J, status  :    Integer; 

■  odereply,aodereply2  :    char; 

acttveaode  :    activecontrolaode; 

targetdepth, 

updatecounter  :    Integer; 

depthrange  :    allowabledepthrange; 

attitude  :    auvattitude; 

(unction    convertdepth   (    analogvalue    :    real   )    :    real; 

{    This    function    converts    a    depth    analog    volts    value    to    an    AUV    status 

parameter.       This    function    is    derived    froa    experimental    observation.  } 


begin  { function    convertdepth       

convertdepth    :=    (    analogvalue    -    1.6270    )   /    0.2570    ; 

end;  { function    convertdepth      

function    convertspeed   (    analogvalue    :    real   )    :    real; 

{    This    function    converts    a    speed    analog    volts    value    to    an   AUV    status 

parameter.      This    function    is    derived    froa    experimental    observation  } 

(    Speed   of    the   AUV   was    determined   by    hand-tiaing    the    vehicle's    passage    in    the 
test    tank,   over    a   distance    of    8ft    (    2    window    panels    )   while    holding    the    speed 
voltage   constant.   Various    trials    were    performed    at    different    Input    voltages 
to    establish   a    voltage    to    speed    relationship.      In    theory    this    is    a   quadratic 
relationship.   The    data    alluded    to    a    quadratic    relationsip,    but    because    the 
voltage    saturated    the    range   quickly,    it    was    difficult    extract    a   precise 
function.      Accordingly    this    function    asserts    average    speed   values    for   various 
ranges    of    voltages    based    on    the    timing    trials.      This    conversion    will 
undoubtedly    becoae    better    defined    as    more    vehicle    data    is    taken    and    analyzed.} 


begin  { function   convertspeed 
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if  (    analogvalue    <=    2.32    )    then 

convertspeed    :=    0.0 
else    if    (    analogvalue    >    2.3200    )    and   (    analogvalue    <=    2.5200    )    then 

convertspeed    :=    1.2678 
else    If    (    analogvalue    >    2.5200    )    and    (    analogvalue    <=    2.5440    )    then 

convertspeed    :=    1.3913 
else    If    (    analogvalue    >    2.5440    )    and    (    analogvalue    <=    2.6200    )    then 

convertspeed    :=    1.8233 
else    If    (    analogvalue    >    2.6200    )    then 

convertspeed    :=    1.8233 
end;  {    function    convertspeed      

function    conver tpltchrate    (    analogvalue    :    real    )    :    real; 

{    This    function    converts    a    pltcbrate    analog    volts    value    to    an    AUV    status 
paraaeter.       This    function    is    derived    from    experimental    observation.  } 


const 

convertconstant  =  0.125;     {  conversion  constant 

begin  {  function  conver tpltchrate 

convertpitchrat e  :=  analogvalue  /  convertconstant; 

end;  (  function  convertpitchrat e 


ActlveControlScreen 


} 


} 


procedure    ClosedLoopControlScreen; 

{    This    procedure    displays    the    Closed  Loop   Control    Screen.    It    is    displayed 
throughtout    the    AUV    pilotting    run.      It    is    updated    with    status    and    control 

parameters    by    control    routines    as  they    execute    in    the    program    sequence.  } 


begin  {    

clrbox2    (xl,yl,x2,y2); 

boxprlnt(yl  +  l,xl,x2,'A    UV      STATUS      /      CONTROL      SCREE    N'); 

boxprint(yl +  2, xl,x2, '  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  '); 

boxprint(yl  +  4,xl,x2, 'STATUS    OF    A    U    V    OPERATING    PARAMETERS    :'); 


wrlteln    (tabxy    (xl  +  5,yl  +  6),'AUV    DEPTH  [    In    ] 

wrlteln    (tabxy    (xl  +  5,yl*7),'AUV    SPEED  [    ft/sec    ] 

wrlteln    (tabxy    (xl*5,yl  +  8),'AUV    PITCHRATE    [    Deg   /    sec    ] 
boxprlnt(yl  +  10,xl,x2,'A    U    V      CONTROL    STATUS'); 

write   (tabxy   (xl  +  5,y  1*12),'CURRENT   TARGET   DEPTH 


'); 


write   (tabxy   (xl  +  5,yl  +  13),'CURRENT   AUV    OPERATING   MANEUVER    :    '): 
write   (tabxy    (xl  +  5,yl*14),'CURRENT    AUV   OPERATING    MODE              :   '); 
boxprtnt(yl  +  17,xl,x2,'THIS    WILL    BE    THE   DISPLAY    DURING      AUV   CONTROL); 
boxprint(yl*18,xl,x2,'STATUS    WILL   BE   UPDATED    EVERY    SECOND.    '); 
boxprtnt(yl  +  19,xl,x2,'NEXT    :         ENTER   AUV   OPERATING   DEPTH   '); 
boxpause(xl«-15,yl  +  21); 
end;  {    ActlveControlScreen    ) 
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procedure    GetTarge tDepth    (var    tgtdepth    :    Integer    ; 

var    tgtdepthvolt s    :    real    ); 

(    This    procedure    solicits    the    target    AUV    operating    depth    and    converts    It    to 
an    AUV    equivalent    tgtdepth    analog    voltage    and    passes    both    of    these 
parameters.    ) 


begin  {    GetTargetDepth    } 

clrbox2    (xl,yl,x2,y2); 

boxprlnt(yl  +  10,xl,x2, 'ENTER    THE    AUV    TARGET    OPERATING    DEPTH'); 
boxprint(yl  +  ll,xl,x2,'>>    NOTE    :    THE    DEPTH    SHOULD    BE    IN    WHOLE    INCHES    <<'); 
repeat 
begin 

boxprlnt    (y  1*  1 3,xl,x2, ENTER    THE    TARGET    OPERATING    DEPTH    '); 
gotoxy   (xl  +  33,yl  +  15); 
read    (    tgtdepth    ); 
end; 
until   (    tgtdepth    In      [0..45]); 
{    This    next    statement    converts    the    Integer    user    input    target    depth    to    an 
analog    control    voltage    base    on    tank    calibration    test    data    acquired.  } 

tgtdepthvolts    :  =    1.627    *■    0.257    *       tgtdepth    ; 

end;  {    GetTargetDepth } 

procedure    RunModeScreen; 

{    This    procedure    displays    the    Closed    Loop   Control    Screen    in    the    RUN    MODE.         } 

begin  {    RunModeScreen    } 

clrbox2    (xl,yl,x2,y2); 

boxprlnt(yl  +  l,xl,x2,'A    UV      STATUS/CONTROL      SCREE    N'); 

boxprlnt(yl+2,xl,x2,*  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  '); 

boxprint(yl  +  4,xl,x2, "STATUS    OF    A    U    V   OPERATING    PARAMETERS    :'); 


write    (tabxy    (xl  +  5,y  1  +  6), 'AUV    DEPTH 
write    (tabxy    (xl  +  5,yl  +  7),'AUV    SPEED 


[  In  ]        :  '); 
[  Ft  /  sec  ]  :  '); 


write  (tabxy  (xl  +  5,y  1  +  8), 'AUV  PITCHRATE  [  Deg  /  sec  ]:  '); 
boxprlnt(yl  +  10,xl,x2,'A  U  V   CONTROL  STATUS'); 


write  (tabxy  (xl  +  5,y  1  +  12), 'CURRENT  TARGET  DEPTH 
write  (tabxy  (xl  +  5,y  1  +  13), 'CURRENT  MODE 
write  (tabxy  (xl  +  5,yl  +  14), 'CURRENT  MANEUVER 


boxprlnt(yl  +  18,xl,x2, 
PRESS  KEY    Fl 

boxprlnt(yl  +  19,xl,x2, 
•PRESS  KEY    F2 

boxprlnt(yl  +  20,xl,x2, 
•PRESS   <  ESC  > 
end;  { 


TO  ENTER  NEW  TARGET  DEPTH. 


'); 


TO  STOP  ACTIVE  CONTROL  AND  RESET.'); 

'); 


TO   EXIT   ACTIVE   CONTROL. 
RunModeScreen 
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procedure    Updat eRunModeScr een    (updat edept  h, updat espeed.upda t epltchrat e    :    real; 

update t argetdepth    :    Integer; 
updateaode:    activeCONTROLmode    ; 
updateat  t  ltude    :    au  vat  t  ltude); 
{       This    module    updates    the    Closed    Loop    Control    Run    Mode    Screen    with    updated 
display    parameters.    Updates    occur    In    Intervals    specified    by    updatelncreaent 
interval    declared    In    ClosedLoopCont rol    procedure.  ) 


begin 


( 


UpdateRunModeScreen 


{  UPDATES         STATUS    OF    A    U    V    OPERATING    PARAMETERS 

wrlteln  (tabxy  (xl  ♦  37, y  1  +  6),updatedepth:6:2); 
wrlteln  (tabxy  (xl  +  37,y  1  +  7),updatespeed:6:2); 
wrlteln    (tabxy    (xl  +  37, y  1  +  S),  updat  epltchrat  e:6:2); 

{    UPDATES    THE  A    U    V       CONTROL    STATUS 

write    (tabxy    (xl +  30,y  1  + 12),updatet  argetdepth:2); 
case    updatemode    of 

run      :    wrlteln    (tabxy    (xl +  30,yl +  1  3),'RUN      '); 

reset:    wrlteln    (tabxy    (xl  *  30, yl  +  1  3), 'RESET'); 

exit    :    wrlteln    (tabxy    (xl  +  30,y  1  «■  1  3), 'EXIT   *); 
end; 
case    updateattitude    of 


maintain 

climb 

diving 


wrlteln    (tabxy    (xl +  30, yl +  1  4), 'MAINTAINING    DEPTH  '); 

wrlteln    (tabxy    (xl  +  30, y  1  +  14), "CLIMBING    TO   TARGET    DEPTH'); 
wrlteln    (tabxy    (xl +  30, yl +  14), 'DIVING    TO    TARGET    DEPTH      '); 


end; 


end; 


( 


UpdateRunModeScreen 


procedure    GetDlgltalSensoryData    (    var    depthanalogvolts.speedanalogvolt s, 

pltchrat eanalogvolt s    :real)    ; 

{      This    procedure    uses    PCLAB    routines    to    sample    selected    input    telemetry 
channels    from    the    AUV    and    digitizes    these    Inputs    and   multiplies    them 
by    the    specified    gains. 

DT    2S01-A    /    DT    707    Board    set    up:         channel    1       -    AUV    depth    input 

channel    2       -    AUV    speed    input 
channel    3       -    AUV    pitchrate    input 

const 

{    These    are    artificial   gains    used   to    simulate   AUV    telemetry    during   program 
development.      One    signal    from    a    signal   generator   (+/-    1.25,    9    Hz, 
characteristic   of    the   pitchrate    signal)    Is    input    to    all    3    input    channels. 
Gains    are    applied    to    simulate    the    actual    values.      These    and    their    appli- 
cation   in    the   procedure    body    should   be    removed    after   program   development 
Is    completed. 

depthgain  =    1.0; 

speedgain  -    2.0; 

pltchrategaln    =    1.0; 
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Jonvert    the    digitized    Analog    Data    Values    for    speed,    depth,    pitchrate    to 
analog    voltage    values.       The    algorithm    for    this    conversion    is    found    in 
Appendix    D    of    the    PCLAB    documentation.  } 


depthanalogvolt s    :=    (    depthadv    ■    (depthpf s -depthmf s)/noc    ) 
speedanalogvolt  s    :-    (    speedadv    *    (spdpf  s  -  spdmf  s)/noc    ) 


*    depthmfs; 
-    spdmfs; 


pltchra t eanalogvolt s    :=    (    pitchrateadv    " 

(pltchratepf s    -    pltchr at emf s)/noc    ) 

-    pltchr at emf s; 

end;  (    procedure   GetDlgltalSensoryData       } 


procedure    Errorvolts    (    tdepthvolts,    adepthvolts    :    real; 

var    derrorvolts:    real; 
var    attitude    :    auvattltude         ); 

{    This    module    represents    the    "AUV    Model   Reference    Stale    Space."      Actual 

depth    telemetry    and    the    target    depth    are    compared    and    a    voltage    difference 
is    computed.      This    difference    is    then    "dropped"    through    a    voltage    filter 
to    determine    if    the    difference    if    within    an    acceptable    tolerance,    or    If    a 
corrective    dlveplane    command    Is    necessary.      A    "model    gain"    Is    applied    to 
the    voltage    difference    and    an    errorvoltage    is    calculated    and    passed    to    the 
main    program    for    dive    command    generation.         Although    these    parameters    are 
single    valued,    In    a    multi-state    control    program    these    parameters    could    be 
Implemented    as    arrays    and    the    model    gain    array    could    be    the    result    of    a 
real-time    program    running    synchronously    with    the    main    control    program.         ) 

{    COMPUTATIONAL    SIGN   CONVENTION:    The    voltage    difference    Is    computed    as    the 
difference    between    TARGET    DEPTH,    or    desired   AUV    depth,    and    the    ACTUAL 
DEPTH.      A    PLUS    voltage    DIFFERENCE    generates    down    dive    plane    command; 
A      MINUS    voltage    DIFFERENCE    generates    an    UP    dive    plane    command.  ) 

cons  t 

depthcontroltolerence  =   0.1; 

modelgain  =   1.0;       {  This  simulates  a  model  referenced  } 

(   gain  parameter 
var 

voltsdlf ference       :  real; 


begin        { Errorvolts  

voltsdlf ference  :  =  tdepthvolts  -  adepthvolts; 
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{    These    are    AUV    to    DT    2301-A    /    DT    707    hook    up    board    channel    configurations, 
conversion    and    computational    arguments.  ) 

depthchannel      =    1;  {    AUV    output    to    DT-707    input    channel    assignment) 

depthpfs  =    +  10.0;      (    Peak    depth    signal    value  ) 

depthmfs  =    -10.0;      {    Minimum    depth    signal    value  } 

speedchannel       =    2;  {    AUV    output    to    DT-707    Input    channel    assignment) 

spdpfs  =    +10.0;         {    Peak    speed    signal    value  ) 

spdmfs  =    -10.0;         (    Minimum    speed    signal    value  ) 

pltchratechannel    =    3;         {    AUV    output    to    DT-707    Input    channel    assignment) 
pltchratepfs       =    +10.0;      {    Peak    pltchrate    signal    value  } 

pltchratemfs       =    -10.0;       {    Minimum    pltchrate    signal    value  } 

noc  =    4096;         {    Number    of    Codes;    conversion    resolution. 

The    DT    2801-A    performs    a    12    bit    conversion. 
NOC    =    (2    *    conversion    bits),    ie    4096  ) 

{    SetUpAdc    and    ADConTrlgger    PCL    function    arguments 

:    p    6-8    PCL       documentation       } 

boardnum  =1; 

numa2dchan  =    3; 

tlmingsource  =2;  C   —    Sets    a    external    trigger, Internal   clock    ) 

adcgain  =    1;  {    Sets    the    A/D    gain;    1,2,4,8    are    options       ) 

startchannel  =    1; 

endchannel  =    3; 

var 

speedadv, 

depthadv, 

pltchrateadv, 

slgnaladv,  {    Signal    analog    data    value  } 

counter, status, 

chanum,i,J  :    Integer; 

begin  { procedure    GetDlgltalSenso-    Data    ) 

{    Set    up    the    DT    2801-A    board    to    take    data.  } 

status    :=    SelectBoard   (boardnum); 

(    Set    up    the    DT    2801-A    board    to    take    data    from    3    Input    channels;    Data 
sampling    Is    initiated   by    the   ADConTrlgger    single    channel    sample    of    the 
depth   channel   and    then    single   ADC    value    samples    of    the    speed    and   pltchrate 
follow.      The   Trigger    Is    connected    to    the   DT    707    board    at    terminal    49    from 
a    signal   generating    source.  ) 

status    :  =    ADConTrlgger   (    depthchannel,    adcgain,   depthadv    ); 
status    :  =   ADCValue   (    speedchannel,    adcgain,    speedadv   ); 
status    :-   ADCValue   (   pltchratechannel,    adcgain,    pltchrateadv    ); 
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(    *  +  *  +  +  +  +  +  <.>  +  +  +  +  +  +  <.  +  +    Control    voltage    filter 


.•♦••♦■•♦■  +  +  +  •♦■  +  ♦■♦.♦•♦.  +  ■ 


(    These    conditions    check    If    depth    Is    within    tolerence.      If    so    a    zero    error 
Is    assigned    so    as    to    result    In    a    zero    dlveplane    command. 
If      (    voltsdlf ference    >    0)    and 

(    abs(volt sdlf ference)    <=    depthcont rolt olerence    )    then 
begin 

derrorvolts    :=    0.0; 
attitude    :=    maintain; 
end 
else    If      (    volt sdlf ference    <    0)    and 

(    abs(volt sdlf  ference)    <=    depthcont rolt olerence    )    then 
begin 

derrorvolts    :=    0.0; 
attitude    :-    maintain; 
end 

(    This    condition    checks    If    actual    depth    is    less    than    target    *    tolerence. 
In    this    case    a    DIVE       command    Is    necessary    to    correct    depth. 

else    If      (    voltsdlf ference    >    0)    and 

(    abs(volt sdlf  ference)    >    depthcont roltolerence    )    then 
begin 

derrorvolts    :=    volt  sdlf  ference    *    modelgaln; 
attitude    :=    diving; 
end 

(    This    last    condition    checks    to    see    if    the    actual    depth    is    more    than    target 
tolerence.      In    this    case    climb    command    is    necessary    to    correct    depth.  } 

else    if      (    voltsdlf ference    <    0)    and 

(    abs(volt sdlf  ference)    >    depthcontroltolerence    )    then 

begin 

derrorvolts    :=    volt sdlf ference    *    modelgaln; 

attitude    :  =    climb; 
end; 


end;  { Errorvolts 


procedure    GenerateOlveplaneCommand   (    dlvecommandvolt s    :    real   ); 

{    This    procedure    CONVERTS    the    analog   ERRORVOLTS    signal    to    a    digital    equi- 
valent   voltage    and    sends    this    as    a    COMMAND    to    the    AUV    Interface    device 
for    transmission    as    a    DIVE    PLANE   COMMAND.    It    uses    a    single    DACValue 
routine    call. 

const 

{    DT    2801-A    DIGITAL   TO   ANALOG   Conversion    declarations 

d2achannel    =    0; 
pfs    =    10; 
mfs    =    -    10; 
noc    =    4096; 
var 

digit  aldatavalue,    status  :    Integer; 
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function    ConvertAnalog2Dlgltal    (    analogvalue    :    real    ):    Integer; 

C    This    function    converts    analog    signal    volts    to    an    equivalent 
digital    value.       See    App    D    of    PCLAB    book.  ) 


var 

t  eop 
begin 


real; 


temp    :-      (    analogvalue    -    mfs    )    *    (    (noc    -    1)    /    (pfs    -    mfs    )    ); 
convert analog2dlgltal    :=    round    (    temp    ); 


end; 
begin       { 


GenerateDlvePlaneCommand 


digit aldatavalue    :=    conver tanalog2dlgltal   (    dlvecommandvolts    ); 
{         status    :=    Initialize;      } 

status    :=    selectboard    (1); 

status    :=    dacvalue    (    d2achannel,    digitaldat avalue    ); 
{         status    :=    terminate;         } 


end;         { 


GenerateDlvePlaneCommand 


procedure    InltializeParame ter s    ; 

(    This    procedure    initializes    all    declared    control    and    display    parameters    to 
zero. 


begin 


{ procedure    InitializeParameters    -■ 


end; 


auvdepthvolts    :-    0.0; 
auvspeedvolt  s    :=    0.0; 
auvpitchratevolts    :=    0.0; 
auvdepth    :=    0.0; 
auvspeed    :=    0.0; 
auvpltchrate    :=    0.0; 


{ procedure    InitializeParameters 


56 


begin  {    ClosedLoopControl       ) 

activemode    :~    run; 
Inltlallzeparameters; 

repeat  {    Repeat    until    activemode    =    exit       } 

repeat  {    Repeat    until    activemode    =    reset  ) 

ClosedLoopControlScreen; 

GetTargetDepth    (    targetdepth,    t argetdepthvolt s    ); 

RunModeScreen; 

while    (    not       keyhit    (    modereply,    modereply2))         do 
(NOTE:         THIS    IS    THE    PROGRAMMABLE    INTERRUPT    WHICH    IS    MASKED    BY    THE    PCLAB 
ROUTINES.    THE    USER    MUST    USE    A       CONTROL-BREAK       <    CNTRL">    TO    STOP    PROGRAM 
EXECUTION    AND    EXIT    THE    PROGRAM.  } 

begin 

updatecount er    :-    0; 

while    (    updatecount er    <      upda teincrement    )    do 
begin 
GetDigltalSensoryData    (auvdepthvolts.auvspeedvolts, 

auvpitchra t evolt s    ); 

Errorvolts    (    t argetdepthvolt s,    auvdepthvolt s    , 
deptherrorvolt s,    attitude); 

Genera  t  eDl  veplaneCommand    (    depther  r  orvolt  s    ); 
updatecounter    :=    updat ecounter    v    1; 

end;         {    while    updatecounter    <    updateincrement       } 

auvspeed    :=    convertspeed    (    auvspeedvolt s    ); 
auvdepth    :-    convert dept h    (    auvdepthvolts    ); 
auvpitchrate    :-    convert  pi  tchra  t  e    (    auvpitchratevolts    ); 

Updat eRunModeScreen    (    auvdepth,    auvspeed,    auvpitchrate, 

targetdepth,    activemode,    attitude    ); 

end;  t    while    not    KeyHlt  } 

If    (ord(aodereply)    =    27)    and   (ord(modereply2)    =    59)    then 

activemode    :=    run  {   KeyHlt=Fl    ) 

else    if   (ord(modereply)    =    27)    and   (ord(modereply2)    =    60)    then 

activemode    :=    reset  {    KeyHlt=Fl    ) 

else    if    (ord(modereply)    =    27)    and   (ord(modereply 2)    =    0)    then 

activemode    :=    exit;  {    KeyHit=    ESC) 

until   (    activemode    =    reset    )    or    (activemode    =    exit    ); 

until   (    activemode    =    exit    ); 
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end;  {  ClosedLoopControl    } 

begin         {  S t atusAndCommand  

repeat 

StatusAndCommandScreen; 
GetKey    (",mode,mode2); 

If    (    ord    (mode)    =    27    )    and    (    ord    (mode2)    =    59    )    then 
begin 

clrbox2    (xl,yl,x2,y2); 
ClosedLoopControl; 
end; 
until    (    mode    In    ['Q'.'q'l   ); 

end;  {    StatusAndCommand    

procedure    InltlalizeZeroDigltalSlgnalOut; 

{    This    procedure    MUST    be    executed    as    the    first    procedure    called    in    the    main 
program    to    insure    a    zero    signal    out    on    the    2    output    channels.         Otherwise    the 
OT    2S01-A    board    defaults    to    a    minimum    full    scale    output.  } 

cons  t 

dlgitalchanO  =  0; 

dlgitalchanl  =  1; 

digit  alcommandboard  -  1; 

var 

status, 

digit  aldatavalue  :    integer; 

begin 

dlgltaldatavalue    :=    2048;  {    This    will   be    converted    to    an    equivalent 

zero    analog    signal    out    on    a    12    bit 
resolution    converter    like    DT    2801-A.         } 

status  :=  Initialize; 

status  :=  selectboard    (    digitalcommandboard   ); 

status  :-  dacvalue    (    digit alchanO,    dlgltaldatavalue    ); 

status  :=  dacvalue    (    dlgitalchanl,    dlgltaldatavalue    ); 

status  :-  terminate; 
end; 

procedure    DeactivateADBoardAndExlt  Pro  gram; 

{    This    procedure    deactivates    the    OT    2301-A    board    and   presents 

an    exit    screen.  ) 

var 

status  :  integer; 


begin   {  DeactlvateADBoardAndExltProgram 

status  :=  terminate; 
clrbox2  (xl,yl,x2,y2); 
boxprlnt  (yl*10,xl,x2, 

'THIS  CONCLUDES  YOUR  AUV  AUTOPILOTTING  SESSION  ,  BYE*); 


end;    {  DeactlvateADBoardAndExltPrograi 
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BEGIN  {    MAIN    PROGRAM 

InitiallzeZeroDigltalSlgnalOut; 

clrscr; 

repea  t 

MainMenu    (    option    ); 
If    (    option    in    ['R'.'r'])    then 
begin 

repeat 
begin 

S t atu sAndCommand    (    controlaode    ); 
end; 
until    (    controlmode    in    ['q'.'Q']); 
end; 
until    (    option    in    ['Q'.'q']); 

Deact ivat eADBoardAndExit Program; 

END.  {    MAIN    PROGRAM 
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